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机 器 人 的 控制 方法 、 装 置 .设备 及 计算 机 可 

读 存 储 介 质 

(57) 摘要 当 受 挖 的 机 器 人 处 于 工作 状态 S201 
本 申请 提供 了 机 器 人 的 控制 方法 、 装 置 、 设 时 ， 采 集 机 器 人 的 状态 数据 

备 及 计算 机 可 读 存储 介质 ,可 在 未 使 用 力矩 传 感 

器 的 条 件 下 ,为 机 器 人 的 碰撞 检测 处 理 提 供 关节 了 0 Se jeer 009 

处 的 力 珑 数据 ,可 避免 配置 力矩 传感器 带 来 的 硬 器 人 的 关节 电机 的 前 饥 力 短 

件 成 本 以 及 构造 改动 成 本 ,本 申请 提供 的 一 种 机 


器 人 的 控制 方法 ,包括 : 当 受 控 的 机 器 人 处 于 工 
作 状 态 时 ,采集 机 器 人 的 状态 数据 ;将 状态 数据 
输入 预先 为 机 器 人 训练 好 的 动力 学 模型 ,得 到 机 
器 人 的 关节 电机 的 前 饥 力 矩 ; 提 取 关 节 电 机 所 处 


提取 关节 电机 所 处 反馈 回路 设 ， 
置 的 反馈 控制 器 输出 的 反馈 力 S203 
短 


有 反馈 力矩 作为 补偿 控制 源 的 基础 上 ,根据 前 馈 力 基础 上 ， 根 据 前 饥 力 给 生成 控 S204 
可 > ] 愉 生 Ar 中 || -2 二 力矩 ， 并 以 控制 力矩 控制 3 
矩 生成 控制 力矩 ,并 以 控制 力矩 控制 关节 电机 的 ee 


王 作 。 
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1 .一 种 机 器 人 的 控制 方法 ,其 特征 在 于 ,所 述 方法 包括 ; 

当 受 控 的 机 器 人 处 于 工作 状态 时 ,采集 所 述 机 器 人 的 状态 数据 ; 

将 所 述 状 态 数 据 输入 预先 为 所 述 机 器 人 训练 好 的 动力 学 模型 ,得 到 所 述 机 器 人 的 关节 
电机 的 前 馈 力 和 矩 

提取 所 述 关 节 电机 所 处 反馈 回路 设置 的 反馈 控制 器 输出 的 反馈 力矩 ; 

在 所 述 反 馈 力矩 作为 补偿 控制 源 的 基础 上 ,根据 所 述 前 馈 力 和 矩 生成 控制 力矩 ,并 以 所 
述 控制 力矩 控制 所 述 关节 电机 的 工作 。 

2 .根据 权利 要 求 1 所 述 的 方法 ,其 特征 在 于 ,所 述 动力 学 模型 具体 为 神经 网 络 模型 ,所 
述 神经 网 络 模型 是 通过 标注 有 对 应 前 馈 力 矩 的 不 同 状态 数据 训练 得 到 的 。 

3 .根据 权 利 要 求 1 所 述 的 方法 ,其 特征 在 于 ,所 述 方法 还 包括 : 

将 所 述 反 馈 力矩 与 反馈 力矩 突变 阔 值 进行 比 对 ,所 述 反馈 力矩 突变 阔 值 为 所 述 机 器 人 
的 碰撞 事件 配置 的 所 述 反馈 力 矩 的 突变 阔 值 ; 
若 所 述 反馈 力矩 达到 所 述 反 馈 力矩 突变 阔 值 , 则 确定 发 生 所 述 机 器 人 的 碰撞 事件 ,所 
述 碰撞 事件 用 于 指示 所 述 机 器 人 发 生 碰撞 。 

4. 根 据 权 利 要 求 3 所 述 的 方法 ,其 特征 在 于 ,所 述 反馈 力矩 突变 阔 值 是 跟随 所 述 机 器 人 
的 动态 运动 状态 设置 的 ,所 述 反 馈 力 矩 突变 阔 值 通过 以 下 计算 公式 计算 得 到 : 

b(t)}=Qw, +p,tanh(a)(1—tanh(Gy’ )) + 

其 中 ,i 用 于 指示 所 述 关 节 电 机 所 属 关节 的 关节 标识 ,v; 用 于 指示 运行 速度 ,a, 用 于 指示 
加 速度 ,a 用 于 指示 第 一 增益 ,B, 用 于 指示 第 二 增益 , 9; ,4 分 别 用 于 指示 tanh 函 数 在 零 值 附 
近 的 突变 速度 以 及 形式 ,t, ,用 于 指示 所 述 关节 的 基础 偏 置 值 。 

5. 根 据 权利 要 求 3 所 述 的 方法 ,其 特征 在 于 ,所 述 确定 发 生 所 述 机 器 人 的 碰撞 事件 之 
后 ,所 述 方法 还 包括 : 

根据 所 述 反馈 力矩 的 力矩 特征 ,确定 所 述 碰撞 事件 的 碰撞 类 型 ; 

根据 所 述 碰撞 类 型 ,确定 所 述 机 器 人 对 所 述 碰撞 事件 的 安全 响应 策略 ; 

执行 所 述 安全 响应 策略 。 

6. 根 据 权 利 要 求 5 所 述 的 方法 ,其 特征 在 于 ,所 述 根据 所 述 反馈 力矩 的 力矩 特征 ,确定 
所 述 碰撞 事件 的 碰撞 类 型 ,包括 : 
确定 所 述 反馈 力矩 的 维持 时 长 t+ 以 及 增长 速率 ni 

若 7 > 7 、t>t,, 确 定 刚 性 物体 碰撞 类 型 ,n， ,以 及 t, 分 别 为 所 述 机 器 人 在 所 述 反馈 
力矩 对 应 当前 速度 v 下 测 得 的 刚性 增长 速度 以 及 维持 时 长 , 77, 为 预 设 的 增长 速度 负 向 偏 
置 ; 

其 中 , 若 7>7vr+ 必 了 ,确定 所 述 碰 撞 物 体 与 所 述 机 器 人 相向 运动 : 
定 所 述 碰撞 物体 与 所 述 机 器 人 同 向 运动 ;车 <7r+ 呀 ,上 且 
> _W, 7 ,确定 所 述 碰撞 物体 为 静止 碰撞 物体 ,以 及 业 分 别 为 预 设 的 刚性 增长 速度 
正 向 增益 以 及 刚性 增长 速度 负 向 增益 ， 

若 7 < 十 7 ,确定 柔性 物体 碰撞 类 型 ,n， ,为 所 述 机 器 人 在 所 述 反 馈 力矩 对 应 当前 
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速度 v 下 测 得 的 柔性 增长 速度 ,7 为 预 设 的 增长 速度 正 向 偏 置 


其 中 ， 知 7 > + wi 71,/ 
nD WD, , 确 
>7w Wi 7 ,确定 


度 正 向 增益 以 及 柔性 增长 速度 负 向 增益 
若 未 确定 


体 碰撞 类 型 。 


7. 根 据 权利 要 求 6 所 述 的 方法 


确 


Lenny 


,确定 所 述 碰 擅 物 体 与 所 述 
定 所 述 碰撞 物体 与 所 述 机 器 人 同 向 运 
所 述 碰撞 物体 为 


| 


> 
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所 述 刚性 物体 碰撞 类 型 ,也 未 确定 


,其 特征 在 于 ,所 述 根据 所 述 


所 述 柔 性 物体 人 


机 器 人 相向 运 
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去 行 ; 知 


动 ; 若 1<Vr+Wzyr 且 


止 碰撞 物体 , wr 以 及 wy 分 别 为 预 设 的 柔性 


撞 类 型 , 则 确定 


增长 速 


试探 性 物 


碰撞 类 型 ,确定 所 述 机 器 人 


对 所 述 碰 撞 事件 的 安全 响应 策略 ,包括 : 

若 所 述 磁 撞 类 型 为 同 向 运动 , 则 确定 比例 缩减 运动 趋势 的 安全 响应 策略 ; 

车 所 述 碰 撞 类 型 为 相向 运动 且 为 所 述 刚 性 物体 碰撞 类 型 , 则 确定 回 退 N 帧 运行 轨迹 或 
者 返回 指定 安全 位 姿 的 安全 响应 策略 ; 

若 所 述 碰撞 类 型 为 相向 运动 且 为 所 述 柔 性 物体 碰撞 类 型 , 则 确定 零 力 控制 或 者 柔顺 控 
制 的 安全 响应 策略 ; 

若 所 述 碰撞 类 型 为 所 述 静 止 碰撞 物体 且 为 所 述 刚性 物体 磁 撞 类 型 , 则 确定 所 述 回 退 N 
帧 运行 轨迹 或 者 返回 指定 安全 位 姿 的 安全 响应 策略 ; 

若 所 述 碰撞 类 型 为 所 述 静 止 磁 撞 物体 且 为 所 述 柔 性 物体 碰撞 类 型 且 处 于 人 机 协作 环 
境 , 则 确定 所 述 零 力 控制 或 者 柔顺 控制 的 安全 响应 策略 ; 

若 所 述 碰撞 类 型 为 所 述 静 止 磁 撞 物 体 且 为 所 述 柔 性 物体 碰撞 类 型 且 未 处 于 人 机 协作 
环境 , 则 确定 所 述 回 退 N 帧 运行 轨迹 或 者 返回 指定 安全 位 姿 的 安全 响应 策略 。 

8. 一 种 机 器 人 的 控制 装置 ,其 特征 在 于 ,所 述 装 置 包括 : 


采集 单元 ,用 于 当 受 控 的 机 器 人 处 于 工作 状态 时 ,采集 所 述 机 器 人 的 状态 数据 ; 
输入 单元 ,用 于 将 所 述 状态 数据 输入 预先 为 所 述 机 器 人 训练 好 的 动力 学 模型 ,得 到 所 
述 机 器 人 的 关节 电机 的 前 馈 力 和 窍 ; 


提取 单元 ,用 于 提取 所 述 关节 电机 所 处 反馈 回路 设置 的 反馈 控 
生成 单元 ,用 于 在 所 述 反馈 力矩 作为 补偿 控 


制 力矩 ; 


钳 


的 方法 。 


10. 一 种 计算 机 可 读 存 储 介 


全 抽 单 元 ,用 于 以 所 述 控 
9. 一 种 机 器 人 的 控 


制 源 的 基础 上 


制 力矩 控 


制 所 述 关节 电机 的 工作 。 


,根据 所 述 


令 , 所 述 指令 


质 , 其 特征 在 于 ,所 述 计算 机 可 读 存 储 介 
信 适 于 处 理 器 进行 加 载 ,以 执行 权利 要 求 1 至 7 任 一 项 所 述 的 方法 。 


| 器 输出 的 反馈 力矩; 
前 馈 力矩 生成 控 


I 设备 ,其 特征 在 于 ,包括 处 理 器 和 存储 器 ,所 述 存 储 器 中 存储 有 计 
算 机 程序 ,所 述 处 理 器 调用 所 述 存储 器 中 的 计算 机 程序 时 执行 如 权利 要 求 1 至 7 任 一 


项 所 述 


质 存储 有 多 条 指 
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技术 领域 


[0001] 本 申请 涉及 机 器 人 控制 领域 ,具体 涉及 机 器 人 的 控制 方法 、 装 置 ` 设 备 及 计算 机 可 
读 存 储 介质 。 


背景 技术 

[0002] 如今 ,机 器 人 在 自动 化 的 工业 生产 中 ,扮演 着 重要 的 角色 ,通过 机 器 人 的 大 规模 应 
用 ,在 稳定 的 产品 质量 的 情况 下 , 极 大 的 提高 了 生产 效率 。 

[0003] ”而 伴随 机 器 人 技术 的 逐步 更 新 ,很 多 类 型 的 机 器 人 的 体积 也 呈现 出 逐步 精简 化 的 
发 展 趋势 ,尤其 一 些 注重 人 机 协作 性 能 的 机 器 人 ,在 体积 逐步 精简 化 的 同时 ,用户 与 机 器 人 
之 间 的 距离 也 出 现 逐 步 缩短 的 趋势 ,也 因此 ,机 器 人 在 工作 过 程 中 ,其 碰撞 检测 格外 重要 ， 
展 好 的 碰撞 检测 技术 ,可 使 得 机 器 人 遇 到 碰撞 事件 时 , 科 根 据 碰 撞 检 测 结果 进行 更 好 的 反 
应 ,不 仅 可 减少 机 器 人 与 其 他 机 器 人 、 设 备 造 成 磁 撞 时 带 来 的 损失 ,更 重要 的 是 还 可 避免 机 
器 人 对 用 户 带 来 安全 隐患 。 

[0004] ”而 在 现 有 的 相关 技术 的 研究 过 程 中 ,发 明 人 人 发现, 在 一 些 机 器 人 碰撞 检测 技术 中 ， 
力矩 感知 作为 机 器 人 碰撞 检测 过 程 中 的 重要 一 环 ,需要 机 咒 人 在 对 应 关节 处 安装 蛙 维 力矩 
传感器 ,以 进行 关节 力矩 的 测量 ,进而 根据 关节 力矩 监控 实现 碰撞 检测 ,在 该 背景 下 ,机 器 
人 在 关节 的 构造 上 需要 适 配 力 矩 传 感 器 ,在 机 器 人 原先 未 在 关 贡 处 安装 力矩 传感器 ,还 需 
进行 关节 构造 的 改动 ,甚至 可 能 还 需 对 机 器 人 的 整体 构造 进行 改动 ,而 对 于 这 类 机 器 人 适 
配 力矩 传感器 进行 的 构造 改动 ,显然 ,成 本 耗费 无 疑 是 巨大 的 ,这 影响 了 机 器 人 碰撞 检测 技 
术 的 应 用 。 


发 明 内 容 

[0005] ”本 申请 提供 了 机 器 人 的 控制 方法 、 装 置 、 设 备 及 计算 机 可 读 存 储 介质 ,可 在 未 使 用 
力矩 传感器 的 条 件 下 ,为 机 器 人 的 碰撞 检测 处 理 提 供 关 节 处 的 力矩 数据 ,可 避免 配置 力矩 
传感器 带 来 的 硬件 成 本 以 及 构造 改动 成 本 。 

[0006] ”第 一 方面 ,本 申请 提供 了 一 种 机 器 人 的 控制 方法 ,方法 包括 : 

[0007] “ 当 受 控 的 机 器 人 处 于 工作 状态 时 ,采集 机 器 人 的 状态 数据 ; 

[0008] ”将 状态 数据 输入 预先 为 机 器 人 训练 好 的 动力 学 模型 ,得 到 机 器 人 的 关节 电机 的 前 
馈 力 矩 ; 

[0009] ”提取 关节 电机 所 处 反馈 回路 设置 的 反馈 控制 器 输出 的 反馈 力矩 ; 

[0010] ”在 反馈 力矩 作为 补偿 控制 源 的 基础 上 ,根据 前 馈 力矩 生成 控制 力矩 ,并 以 控 各 
和 矩 控制 关节 电机 的 工作 。 
[0011] ”结合 本 申请 第 一 方面 ,在 本 申请 第 一 方面 第 一 种 可 能 的 实现 方式 中 ,动力 学 模型 
具体 为 神经 网 络 模型 ,神经 网 络 模 型 是 通过 标注 有 对 应 前 馈 力 算 的 不 同 状态 数据 训练 得 到 
的 。 

[0012] ”结合 本 申请 第 一 方面 ,在 本 申请 第 一 方面 第 三 种 可 能 的 实现 方式 中 ,方法 还 包括 : 
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[0013] ”将 反馈 力矩 与 反馈 力矩 突变 阔 值 进行 比 对 ,反馈 力矩 突变 阔 值 为 机 器 人 的 碰撞 事 
件 配 置 的 反馈 力矩 的 突变 闵 值 ; 

[0014] ”车 反馈 力矩 达到 反馈 力矩 突变 闷 值 , 则 确定 发 生机 器 人 的 碰撞 事件 ,碰撞 事件 用 
于 指示 机 器 人 发 生 碰撞 。 

[0015] ”结合 本 申请 第 一 方面 第 二 种 可 能 的 实现 方式 ,在 本 申请 第 一 方面 第 三 种 可 能 的 实 
现 方 式 中 ,有 反馈 力矩 突变 阔 值 是 跟随 机 器 人 的 动态 运动 状态 设置 的 ,反馈 力矩 突变 闵 值 通 
过 以 下 计算 公式 计算 得 到 : 

[0016] DOD=wy+ptanh(w)-tanh(cy ) +t,, 

[0017] ”其 中 ,i 用 于 指示 关节 电机 所 属 关 节 的 关节 标识 ,v; 用 于 指示 运行 速度 ,a 用 于 指示 
加 速度 ,a; 用 于 指示 第 一 增益 ,8; 用 于 指示 第 二 增益 , .bh, 分 别 用 于 指示 tanh 函 数 在 零 值 附 
近 的 突变 速度 以 及 形式 ,tu ;用 于 指示 关节 的 基础 偏 置 值 。 

[0018] ”结合 本 申请 第 一 方面 第 二 种 可 能 的 实现 方式 ,在 本 申请 第 一 方面 第 四 种 可 能 的 实 
现 方式 中 ,确定 发 生机 器 人 的 碰撞 事件 之 后 ,方法 还 包括 : 

[0019] ”根据 反馈 力矩 的 力矩 特征 ,确定 碰撞 事件 的 碰撞 类 型 ; 

[0020] ”根据 碰撞 类 型 ,确定 机 器 人 对 碰撞 事件 的 安全 响应 策略 ; 

[0021] ”执行 安全 响应 策略 。 

[0022] ”结合 本 申请 第 一 方面 第 四 种 可 能 的 实现 方式 ,在 本 申请 第 一 方面 第 五 种 可 能 的 实 
现 方式 中 ,根据 反馈 力矩 的 力矩 特征 ,确定 碰撞 事件 的 碰撞 类 型 ,包括 : 

[0023] ”确定 反馈 力矩 的 维持 时 长 +{ 以 及 增长 速率 n; 

[0024] “车 7>7vr -vv 、 t2t， 确 定 刚性 物体 碰撞 类 型 ,n，, 以 及 t, 分 别 为 机 器 人 在 反馈 力 
和 矩 对 应 当前 速度 v 下 测 得 的 刚性 增长 速度 以 及 维持 时 长 ,7 为 预 设 的 增长 速度 负 向 偏 置 ; 
[0025] ”其 中 , 若 7>7%r 填 业 7 ,确定 碰撞 物体 与 机 器 人 相向 运动 ; 若 7< 思 -人 7 ,确定 
碰撞 物体 与 机 器 人 同 向 运动 ; 若 有 Ww 寺 吕 1 且 77>r_W 7, ,确定 碰撞 物体 为 静止 碰 
撞 物 体 ,Ww 以 及 Ww 分 别 为 预 设 的 刚性 增长 速度 正 向 增益 以 及 刚性 增长 速度 负 向 增益 ， 
[0026] ”车 </ 十 11/ ,确定 柔性 物体 碰撞 类 型 ,n， 为 机 器 人 在 反馈 力矩 对 应 当前 速度 v 
下 测 得 的 柔性 增长 速度 , 7 为 预 设 的 增长 速度 正 向 偏 置 ，; 

定 碰撞 物体 与 机 器 人 相向 运行 ;车 < _W 7 , 确 
定 碰撞 物体 与 机 器 人 同 向 运动 ;车 有 <7 于 WW 且 7> 人 -Wi ,确定 碰撞 物体 为 静止 
碰撞 物体 ,Wi 以 及 Wj 分 别 为 预 设 的 柔性 增长 速度 正 向 增益 以 及 柔性 增长 速度 负 向 增益 。 
[0028] ” 若 未 确定 刚性 物体 碰撞 类 型 ,也 未 确定 柔性 物体 碰撞 类 型 , 则 确定 试探 性 物体 碰 
撞 类 型 。 

[0029] ”结合 本 申请 第 一 方面 第 五 种 可 能 的 实现 方式 ,在 本 申请 第 一 方面 第 六 种 可 能 的 实 
现 方式 中 ,根据 碰撞 类 型 ,确定 机 器 人 对 碰撞 事件 的 安全 响应 策略 ,包括 : 

[0030] ” 若 碰 撞 类 型 为 同 向 运动 , 则 确定 比例 缩减 运动 趋势 的 安全 响应 策略 ; 


eu 


[0027] ”其 中 , 若 7>7r 二 WANr , 确 


benny 
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L0031] “ 若 碰 撞 类 型 为 相向 运动 且 为 刚性 物体 碰撞 类 型 , 则 确定 回 退 N 帧 运行 轨迹 或 者 返 
回 指定 安全 位 姿 的 安全 响应 策略 ; 

[0032] “知人 磁 撞 类 型 为 相向 运动 且 为 柔性 物体 碰撞 类 型 , 则 确定 零 力 控制 或 者 柔顺 控制 的 
安全 响应 策略 ; 
[0033] “ 若 磁 撞 类 型 为 静止 碰撞 物体 且 为 刚性 物体 碰撞 类 型 , 则 确定 回 退 N 帧 运行 轨迹 或 
者 返回 指定 安全 位 姿 的 安全 响应 策略 ; 

[0034] ”知人 磁 撞 类 型 为 静止 磁 撞 物体 且 为 柔性 物体 磁 撞 类 型 且 处 于 人 机 协作 环境 , 则 确定 
零 力 控制 或 者 柔顺 控制 的 安全 响应 策略 ; 
[0035] “” 若 磁 撞 类 型 为 静止 碰撞 物体 且 为 柔性 物体 碰撞 类 型 旦 未 处 于 人 机 协作 环境 , 则 确 
定 回 退 N 帧 运行 轨迹 或 者 返回 指定 安全 位 姿 的 安全 响应 策略 。 

L0036] ”第 二 方面 ,本 申请 提供 了 一 种 机 器 人 的 控制 装置 ,装置 包括 : 

[0037] “采集 单元 ,用 于 当 受 控 的 机 器 人 处 于 工作 状态 时 ,采集 机 器 人 的 状态 数据 ; 

[0038] ”输入 单元 ,用 于 将 状态 数据 输入 预先 为 机 器 人 训练 好 的 动力 学 模型 ,得 到 机 器 人 
的 关节 电机 的 前 馈 力 矩 ， 

L0039] ”提取 单元 ,用 于 提取 关节 电机 所 处 反馈 回路 设置 的 反馈 控制 器 输出 的 反馈 力矩 ; 
L0040] ”生成 单元 ,用 于 在 反馈 力矩 作为 补偿 控制 源 的 基础 上 ,根据 前 馈 力矩 生成 控 种 
窍 ; 
[0041] ”控制 单元 ,用 于 以 控制 力矩 控制 关节 电机 的 工作 。 

L0042] ”结合 本 申请 第 二 方面 ,在 本 申请 第 二 方面 第 一 种 可 能 的 实现 方式 中 ,动力 学 模型 
具体 为 神经 网 络 模型 ,神经 网 络 模型 是 通过 标注 有 对 应 前 馈 力 矩 的 不 同 状 态 数 据 训练 得 到 
的 。 

L0043] ”结合 本 申请 第 二 方面 ,在 本 申请 第 二 方面 第 二 种 可 能 的 实现 方式 中 ,装置 还 包括 
判断 单元 ,用 于 : 

L0044] ”将 反馈 力矩 与 反馈 力矩 突变 阔 值 进行 比 对 ,反馈 力矩 突变 阐 值 为 机 器 人 的 碰撞 事 
件 配 置 的 反馈 力矩 的 突变 阐 值 ; 

L0045] ” 若 反 馈 力 矩 达到 反馈 力 窍 突变 闵 值 , 则 确定 发 生机 器 人 的 碰撞 事件 , 磁 撞 事件 用 
于 指示 机 器 人 发 生 磁 撞 。 

L0046] ”结合 本 申请 第 二 方面 第 二 种 可 能 的 实现 方式 ,在 本 申请 第 二 方面 第 三 种 可 能 的 实 
现 方式 中 ,反馈 力矩 突变 阔 值 是 跟随 机 器 人 的 动态 运动 状态 设置 的 ,反馈 力矩 突变 阔 值 通 
过 以 下 计算 公式 计算 得 到 : 

[0047] (DOD=awv+Atanh(a)(-tanh(cy ))+t,， 


[0048] ”其 中 ,i 用 于 指示 关节 电机 所 属 关 节 的 关节 标识 ,v 用 于 指示 运行 速度 ,a; 用 于 指示 
加 速度 ,a 用 于 指示 第 一 增益 ,B 用 于 指示 第 二 增益 , 9; .ua 分 别 用 于 指示 tanh 函 数 在 零 值 附 
近 的 突变 速度 以 及 形式 ,t, ,用 于 指示 关节 的 基础 偏 置 值 。 

[0049] ”结合 本 申请 第 二 方面 第 二 种 可 能 的 实现 方式 ,在 本 申请 第 二 方面 第 四 种 可 能 的 实 
现 方式 中 ,装置 还 包括 响应 单元 ,用 于 : 

[0050] ”根据 反馈 力矩 的 力矩 特征 ,确定 碰撞 事件 的 碰撞 类 型 ; 

[0051] ”根据 碰撞 类 型 ,确定 机 器 人 对 碰撞 事件 的 安全 响应 策略 ; 


We 


ph 


I 


eu 
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[0052] ”执行 安全 响应 策略 。 
[0053] ”结合 本 申请 第 二 方面 第 四 种 可 能 的 实现 方式 ,在 本 申请 第 二 方面 第 五 种 可 能 的 实 
现 方式 中 ,响应 单元 ,具体 用 于 : 

[0054] ”确定 反馈 力矩 的 维持 时 长 + 以 及 增长 速率 ni 


[0055] 知 7 > a 7 二 2 


t>t,, 确 定 刚 性 物体 碰撞 类 型 ,n， ,以 及 t, 分 别 为 机 器 人 在 反馈 力 


矩 对 应 当前 速度 v 下 测 得 的 刚性 增长 速度 以 及 维持 时 长 , ”? 为 预 设 的 增长 速度 负 癌 偏 置 ，; 


[0056] ”其 中 , 若 7>7vr 十 网 和 ,确定 碰撞 物体 与 机 器 人 相向 运动 ; 若 7<r_W 和 iv , 确 
定 碰 接 物体 与 机 器 人 同 向 运动 ;车 7 < 二 吉 7, 且 7>7%r-W 1, ,确定 碰撞 物体 为 静止 
碰撞 物体 ,WW 以 及 W3 分 另 
确 


[0057] “” 若 7 < 4 11/ 
下 测 得 的 柔性 增长 速度 ， 


[0058] ”其 中 , 若 7> Arv 


定 碰 撞 物 体 与 机 器 人 同 向 运动 ;车 7< sr+W 7y 且 7>7r-W 7 ,确定 碰撞 物体 为 静止 
碰撞 物体 ,Wi 以 及 WW 分 别 为 预 设 的 柔性 增长 速度 正 向 增益 以 及 柔性 增长 速度 负 向 增益 ; 


I 为 预 设 的 刚性 增长 速度 正 向 增益 以 及 刚性 增长 速度 负 向 增益 ; 
定 柔 性 物体 碰撞 类 型 ,n， ;为 机 器 人 在 反馈 力矩 对 应 当前 速度 v 
1 /为 预 设 的 增长 速度 正 向 偏 置 ， 

定 碰撞 物体 与 机 器 人 相向 运行 ; 若 7<7/_Wi 7 , 确 


ke 


Wr 717， 7 
十 ”7 有 


bmnny 


L0059] ” 若 示 确定 刚性 物体 碰撞 类 型 ,也 未 确定 柔性 物体 碰撞 类 型 , 则 确定 试探 性 物体 碰 


撞 类 型 。 


[0060] ”结合 本 申请 第 二 方面 第 五 种 可 能 的 实现 方式 ,在 本 申请 第 二 方面 第 六 种 可 能 的 实 
现 方 式 中 » 响应 单元 ,具体 用 于 : 


L0061] 知人 磁 撞 类 型 为 同 向 运动 , 则 确定 比例 缩减 运动 趋势 的 安全 响应 策略 


[0062] ” 知 碰 撞 类 型 为 相向 运动 且 为 刚性 物体 碰撞 类 型 , 则 确定 回 退 N 帧 运行 轨迹 或 者 返 


回 指定 安全 位 姿 的 安全 响应 策略 ; 


L0063] ” 知 碰 撞 类 型 为 相向 运动 且 为 柔性 物体 碰撞 类 型 , 则 确定 零 力 控制 或 者 柔顺 控制 的 


安全 响应 集 略 ; 


[0064] ”车 碰 撞 类 型 为 削 


止 碰撞 物体 且 为 刚性 物体 碰撞 类 型 , 则 确定 回 退 N 帧 运行 轨迹 或 


者 返回 指定 安全 位 姿 的 安全 响应 集 略 ; 


[0065] ”车 碰撞 类 型 为 前 


止 碰撞 物体 且 为 柔性 物体 磁 撞 类 型 且 处 于 人 机 协作 环境 , 则 确定 


零 力 控制 或 者 柔顺 控 市 


| 的 安全 啊 应 策略 ; 


[0066] ”车 碰撞 类 型 为 削 


止 碰撞 物体 旦 为 柔性 物体 磁 撞 类 型 且 未 处 于 人 机 协作 环境 , 则 确 


定 回 退 N 帧 运行 轨迹 或 者 返回 指定 安全 位 姿 的 安全 啊 应 集 略 。 


L0067] ”第 三 方面 ,本 申请 提供 了 一 种 机 器 人 的 控制 设备 ,包括 处 理 器 和 存储 器 ,存储 器 中 
存储 有 计算 机 程序 ,处 理 器 调用 存储 器 中 的 计算 机 程序 时 执行 本 申请 第 一 方面 或 者 本 申请 


第 一 方面 任 一 种 可 能 的 实现 方式 提供 的 方法 。 


[0068] ”第 四 方面 ,本 申请 提供 了 一 种 计算 机 可 读 存 储 介质 ,计算 机 可 读 存 储 介质 存储 有 


多 条 指令 ,指令 适 于 处 理 器 进行 加 载 ,以 执行 本 申请 第 一 方面 或 者 本 申请 第 一 方面 任 一 种 


可 能 的 实现 方式 提供 的 方法 。 
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[0069] ”从 以 上 内 容 可 得 出 ,本 申请 具有 以 下 的 有 益 效果 : 

[0070] ”针对 于 机 器 人 的 碰撞 检测 处 理 , 本 申请 搭建 了 一 以 动力 学 前 馈 为 主体 、 反 馈 控制 
为 辅助 的 机 器 人 控制 框架 ,在 该 框架 下 ,将 采集 到 的 机 器 人 的 状态 数据 通过 动力 学 模型 , 生 
成 关节 电机 的 前 馈 力 矩 ,并 将 该 关节 电机 所 处 反馈 回路 设置 的 反馈 控制 器 输出 的 反馈 
窍 , 视 为 外 部 作用 力 的 观测 器 ,作为 补偿 控制 源 ,结合 前 馈 力 矩 以 及 反馈 力矩 两 者 生成 关节 
电机 的 控制 力矩 ,以 控制 关节 电机 的 工作 ,在 该 过 程 中 ,由 于 在 未 使 用 力矩 传感器 的 条 件 
下 ,为 机 器 人 的 碰撞 检测 处 理 提供 关节 处 的 力矩 数据 ,可 避免 配置 力 窍 传感器 融 来 的 硬件 
成 本 以 及 构造 改动 成 本 。 


附 图 说 明 

[0071] ”为 了 更 清楚 地 说 明 本 申请 实施 例 中 的 技术 方案 ,下 面 将 对 实施 例 描 述 中 所 需要 使 
用 的 附 图 作 简单 地 介绍 ,显而易见 地 ,下 面 描述 中 的 附 图 仅仅 是 本 申请 的 一 些 实施 例 , 对 于 
本 领域 技术 人 员 来 讲 , 在 不 付出 创造 性 劳动 的 前 提 下 ,还 可 以 根据 这 些 附 图 获得 其 他 的 附 


图 。 
[oo72] ”图 1 为 本 申请 机 器 人 的 控制 方法 的 一 种 场景 示意 图 ， 
[0073] ”图 2 为 本 申请 机 器 人 的 控制 方法 的 一 种 流程 示意 图 ; 
[0074] ”图 3 为 本 申请 策略 状态 转移 处 理 的 一 种 场景 示意 图 ， 
[0075] ”图 4 为 本 申请 机 器 人 的 控制 装置 的 一 种 结构 示意 图 ， 
[0076] ”图 5 为 本 申请 机 器 人 的 控制 设备 的 一 种 结构 示意 图 。 
具体 实施 方式 


[0077] 下面 将 结合 本 申请 实施 例 中 的 附 图 ,对 本 申请 实施 例 中 的 技术 方案 进行 清楚 、 完 
整地 描述 ,显然 ,所 描述 的 实施 例 仅仅 是 本 申请 一 部 分 实施 例 , 而 不 是 全 部 的 实施 例 。 基 于 
本 申请 中 的 实施 例 , 本 领域 技术 人 员 在 没有 作出 创造 性 劳动 前 提 下 所 获得 的 所 有 其 他 实施 
例 ,都 属于 本 申请 保护 的 范围 。 

[0078] ”本 申请 的 说 明 书 和 权利 要 求 书 及 上 述 附 图 中 的 术语 第 一 、 第 二 等 是 用 于 区 别 
类 似 的 对 象 ,而 不 必用 于 描述 特定 的 顺序 或 先后 次 序 。 应 该 理解 这 样 使 用 的 数据 在 适当 情 
况 下 可 以 互 换 , 以 便 这 里 描述 的 实施 例 能 够 以 除了 在 这 里 图 示 或 描述 的 内 容 以 外 的 顺序 实 
施 . 此 外 ,术语 "包括 和 “具有 ”以 及 他 们 的 任何 变形 ,意图 在 于 履 盖 不 排他 的 包含 ,例如 , 包 
含 了 一 系列 步骤 或 模块 的 过 程 \ 方 法 系统. 产品 或 设备 不 必 限 于 清楚 地 列 出 的 那些 步骤 或 
模块 ,而 是 可 包括 没有 清楚 地 列 出 的 或 对 于 这 些 过 程 方 法 .产品 或 设备 固有 的 其 它 步骤 或 
模块 。 在 本 申请 中 出 现 的 对 步骤 进行 的 命名 或 者 编号 ,并 不 意味 着 必须 按照 命名 或 者 编号 
所 指示 的 时 间 / 逻 辑 先后 顺序 执行 方法 流程 中 的 步骤 ,已 经 命名 或 者 编号 的 流程 步骤 可 以 
根据 要 实现 的 技术 目的 变更 执行 次 序 , 只 要 能 达到 相同 或 者 相 类 似 的 技术 效果 即 可 。 

[0079] ”本 申请 中 所 出 现 的 模块 的 划分 ,是 一 种 逻辑 上 的 划分 ,实际 应 用 中 实现 时 可 以 有 
男 外 的 划分 方式 ,例如 多 个 模块 可 以 结合 成 或 集成 在 男 一 个 系统 中 ,或 一 些 特征 可 以 忽略 ， 
或 不 执行 ,另外 ,所 显示 的 或 讨论 的 相互 之 间 的 耦合 或 直接 耦合 或 通信 连接 可 以 是 通过 一 
些 接口 ,模块 之 间 的 间接 耦合 或 通信 连接 可 以 是 电 性 或 其 他 类 似 的 形式 ,本 申请 中 均 不 作 
限定 。 并 且 , 作为 分 离 部 件 说 明 的 模块 或 子 模块 可 以 是 也 可 以 不 是 物理 上 的 分 离 , 可 以 是 也 
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可 以 不 是 物理 模块 ,或 者 可 以 分 布 到 多 个 电路 模块 中 ,可 以 根据 实际 的 需要 选择 其 中 的 部 
分 或 全 部 模块 来 实现 本 申请 方案 的 目的 。 

[0080] ”在 介绍 本 申请 提供 的 机 器 人 的 控制 方法 之 前 ,首先 介绍 本 申请 所 涉及 的 背景 
容 。 
[0081] “本 申请 提供 的 机 器 人 的 控制 方法 、 装 置 以 及 计算 机 可 读 存 储 介质 ,可 应 用 于 机 器 
人 的 控制 设备 上 ,可 在 未 使 用 力矩 传感器 的 条 件 下 ,为 机 器 人 的 磁 撞 检测 处 理 提供 关节 处 
的 力矩 数据 ,可 避免 配置 力 算 传 感 嚣 带 来 的 硬件 成 本 以 及 构造 改动 成 本 。 

[0082] ”本 申请 提 及 的 机 器 人 的 控制 方法 ,其 执行 主体 可 以 为 机 器 人 的 控制 装置 ,或 者 集 
成 了 该 机 器 人 的 控制 装置 的 服务 器 、 物 理 主机 或 者 用 户 设备 (User Equipment,UE) 等 机 器 
人 的 控制 设备 。 其 中 ,机 器 人 的 控制 装置 可 以 采用 硬件 或 者 软件 的 方式 实现 ,UE 具体 可 以 为 
智能 手机 、 平 板 电脑 、 笔 记 本 电脑 、 台 式 电脑 或 者 个 人 数字 助理 (Personal Digital 
Assistant,PDA) 等 终端 设备 ,机 器 人 的 控制 设备 可 以 通过 设备 集群 的 方式 设置 。 

[0083] ”其 中 ,可 以 理解 的 是 ,机 器 人 的 控制 设备 ,还 可 和 集成 在 机 器 人 中 ,或 者 直接 为 机 器 
人 本 刁 。 

[0084] 下面 ,开始 介绍 本 申请 提供 的 机 器 人 的 控制 方法 。 
[0085] ”首先 ,结合 图 1 示 出 的 本 申请 机 器 人 的 控制 方法 的 一 种 场景 示意 图 ,参阅 图 2 示 出 
的 本 申请 机 器 人 的 控制 方法 的 一 种 流程 示意 图 ,本 申请 提供 的 机 器 人 的 控制 方法 ,具体 可 
包括 如 下 步骤 : 

[0086] “步骤 $S201 , 当 受 控 的 机 器 人 处 于 工作 状态 时 ,采集 机 器 人 的 状态 数据 ; 

[0087] ”步骤 $S202 ,将 状态 数据 输入 预先 为 机 器 人 训练 好 的 动力 学 模型 ,得 到 机 器 人 的 关 
节 电 机 的 前 馈 力 甜 ; 

[0088] ”步骤 S203 ,提取 关 节 电 机 所 处 反馈 回路 设置 的 反馈 控制 器 输出 的 反馈 力矩 ; 

[0089] ”步骤 3204, 在 反馈 力 算 作为 补偿 控制 源 的 基础 上 ,根据 前 馈 力 窍 生成 控制 力矩 ,并 
以 控制 力矩 控制 关节 电机 的 工作 。 
[0090] ”从 图 2 所 示 实 施 例 可 看 出 ,针对 于 机 器 人 的 碰撞 检测 处 理 , 本 申请 搭建 了 一 以 动力 
学 前 馈 为 主体 、 反 馈 控 制 为 辅助 的 机 器 人 控制 框架 ,在 该 框架 下 ,将 采集 到 的 机 器 人 的 状态 
数据 通过 动力 学 模型 ,生成 关节 电机 的 前 馈 力 矩 , 并 将 该 关节 电机 所 处 反馈 回路 设置 的 反 
馈 控 制 器 输出 的 反馈 力矩 , 视 为 外 部 作用 力 的 观测 器 ,作为 补偿 控制 源 ,结合 前 馈 力 矩 以 及 
反馈 力矩 两 者 生成 关节 电机 的 控制 力矩 ,以 控制 关节 电机 的 工作 ,在 该 过 程 中 ,由 于 在 未 使 
用 力矩 传感器 的 条 件 下 ,为 机 器 人 的 碰撞 检测 处 理 提供 关节 处 的 力矩 数据 ,可 避免 配置 力 
和 矩 传感器 带 来 的 硬件 成 本 以 及 构造 改动 成 本 。 

[0091] ”此 外 ,本 申请 所 提出 的 该 机 器 人 控制 框架 ,针对 于 力矩 控制 ,本 申请 还 在 反馈 控制 
回路 的 基础 上 ,配置 了 前 馈 控 制 回路 ,融合 了 预测 控制 和 闭环 控制 两 者 的 优点 ,可 实现 更 为 
快速 的 力矩 调节 效率 ,进而 为 机 器 人 的 碰撞 检测 处 理 提供 更 为 精确 的 力矩 数据 ,实现 更 为 
精确 、 快 速 的 碰撞 响应 处 理 。 
[0092] 下面 则 对 上 述 图 2 所 示 实 施 例 的 各 个 步 又 及 其 在 实际 应 用 中 可 能 的 实现 方式 进行 
详细 阐述 。 

[0093] ”在 本 申请 中 ,机 器 人 具体 可 以 为 任意 类 型 的 机 器 人 , 当 其 应 用 本 申请 所 提供 的 机 
器 人 的 控制 方法 后 ,可 在 关节 处 为 配置 力矩 传感器 的 情况 下 , 仍 可 采集 机 器 人 的 磁 撞 检测 
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处 理 所 需 的 力矩 数据 。 

L0094] ”当然 ,可 以 理解 的 是 ,机 器 人 也 可 配置 力矩 传感器 ,并 可 在 与 力矩 传感器 相对 独立 
的 情况 下 ,通过 应 用 的 本 申请 所 提供 的 机 器 人 的 控制 方法 ,采集 机 器 人 的 碰撞 检测 处 理 所 
需 的 力矩 数据 ,结合 力矩 传感器 采集 的 力矩 数据 以 及 忽略 力矩 传感器 采集 的 力矩 数据 两 
者 ,还 可 进行 数据 比 对 、 数 据 校正 等 一 系列 的 数据 处 理 , 具 体 可 随 实 际 需 要 调整 。 

[0095] ”针对 机 器 人 具体 所 需 控制 的 关节 ,可 以 将 其 关节 电机 作为 目标 ,部 署 闭环 控制 回 
路 ,将 关节 电机 的 输出 作为 被 控 量 ,结合 设 定 的 状态 量 进 行 比 对 ,并 根据 两 者 的 偏差 进行 控 
制 ,以 达到 消除 偏差 的 目的 。 

L0096] ”在 闭环 控制 回路 中 ,可 通过 反馈 控制 器 进行 控制 ,例如 PID 调 节 器 .DCS 调 节 器 、PLC 
空 制 器 等 类 型 的 控制 器 。 

[0097] ”闭环 控制 回路 为 常用 在 机 器 人 控制 系统 中 的 控制 方案 ,而 在 该 基础 上 ,本 申请 还 
引入 了 前 馈 控制 回路 ,前 馈 控 制 回路 , 相 比 于 闭环 控制 回路 实现 的 闭环 控制 方式 ,其 实现 的 
是 预测 控制 方式 ,通过 动力 学 模型 ,对 模型 输入 的 机 器 人 的 状态 数据 进行 动力 学 分 析 人 处理 ， 
输出 前 馈 力矩 ,其 可 以 理解 为 一 种 开 环 控制 回路 ,将 输入 的 状态 数据 作为 扰动 量 ,基于 补偿 
原理 ,对 关节 电机 进行 预测 性 的 力矩 控制 。 
[0098] ”如 此 ,在 反馈 控制 回路 的 基础 上 ,配置 了 前 馈 控 制 回路 ,融合 了 预测 控制 和 闭环 控 
制 两 者 的 优点 ,可 实现 更 为 快速 的 力 矩 调节 效率 。 
L0099] ”其 中 ,具体 的 ,可 县 加 反馈 控制 回路 的 反馈 力矩 以 及 前 馈 控 制 回路 的 前 饥 力 矩 ,得 
到 控制 力矩 来 控制 关节 电机 。 

L0100] ”当然 ,还 可 引入 更 为 复杂 的 数据 处 理 策略 ,以 更 好 得 结合 反馈 力矩 以 及 前 馈 力 矩 
两 者 ,生成 更 为 精确 有 效 的 控制 力矩 来 控制 住 关节 电机 。 


= 


== 


ds 


L0101] ”状态 数据 ,具体 可 以 为 速度 数据 、 加 速度 数据 等 预先 选 定 的 状态 通过 传感器 直接 
测 得 或 者 间接 测 得 的 数据 ,又 或 者 是 通过 元 器 件 工作 参数 计算 得 到 ,例如 通过 电机 的 力矩 


常熟 和 电流 值 推算 。 

[0102] “在 实际 应 用 中 ,动力 学 模型 可 以 为 工作 人 员 预 先 训 练 的 模型 ,作为 一 种 适 于 实用 
的 实现 方式 ,动力 学 模型 除了 可 以 为 工作 人 员 预 先 训练 的 固定 参数 .固定 公式 的 集合 , 例 
如 ,使 用 拉 格 朗 日 法 和 牛顿- 欧 拉 法 ,通过 机 器 人 具体 形式 确定 机 器 人 动力 学 辨识 参数 , 设 
计 激 励 轨迹 获取 机 器 人 对 应 参数 具体 数值 ,动力 学 模型 还 可 以 为 神经 网 络 模型 ,从 而 以 人 
工 智能 Artificial Intelligence,AD) 的 方式 ,实现 更 为 复杂 、 灵 活 的 动力 学 模型 处 理 机 
制 |。 

[0103] ”该 神经 网 络 模 型 具体 可 通过 标注 有 对 应 前 馈 力矩 的 不 同 状 态 数据 训练 得 到 ,如 ， 
依次 将 状态 数据 输入 神经 网 络 模型 ,进行 前 馈 力 窍 的 计算 ,进行 模型 的 正 向 传播 ,并 可 根据 
模型 输出 的 前 馈 力 和 矩 计算 结果 计算 计算 损失 函数 ,优化 模型 的 参数 ,进行 模型 的 反 向 传播 ， 
当 得 到 训练 次 数 、 训 练 时 长 ,计算 精度 等 训练 目标 时 则 可 完成 模型 的 训练 。 

[0104] ”实际 控制 过 程 中 ,可 将 前 馈 控 制 回路 作为 主要 控制 源 ,将 反馈 控制 回路 作为 补偿 
控制 源 ,在 动力 学 模型 较 精 确 的 前 提 下 ,可 认为 反馈 控制 回路 主要 用 于 检测 外 界 对 机 器 人 
本 体 干扰 的 存在 , 即 外 部 对 其 本 身 的 干扰 ,由 于 反馈 控制 回路 对 抗 干扰 的 作用 ,因此 在 原 
上 可 将 反馈 力矩 视 作 外 部 作用 力 的 观测 器 ,另外 ,机 器 人 各 关节 电机 的 反馈 控制 回路 可 相 
互 独立 ,因此 可 优选 地 直接 使 用 各 关节 电机 的 反馈 输出 力矩 作为 干扰 观测 器 。 


Sr 


上 蜡 


10 


CN 113021340 A 说 明 书 8/14 页 


[0105] Tok T= TT 

[0106] ” 式 中 ,表示 实际 采样 的 力矩 值 ,1 表示 通过 测量 动力 学 模型 预测 的 前 僻 力矩 值 ， 

+ 表示 反馈 控制 回路 作用 的 实际 力矩 值 ,用 于 观测 外 力 的 变化 情况 。 

L0107] ”而 在 上 述 机 器 人 控制 框架 下 ,所 提供 的 力矩 数据 ,还 可 为 机 器 人 的 碰撞 检测 处 理 

提供 数据 支持 ,或 者 说 ,提供 倍 撞 检测 处 理 的 判定 标准 和 依据 。 

L0108] ”例如 ,可 以 将 反馈 力矩 做 维护 机 器 人 的 碰撞 检测 处 理 的 输入 量 。 

L0109] ”作为 一 种 具体 的 实现 方式 ,基于 反馈 力矩 所 处 的 碰撞 检测 机 制 ,可 包括 : 

[0110] “将 反馈 力 珑 与 反馈 力矩 突变 阀 值 进行 比 对 ,反馈 力矩 突变 冰 值 为 机 器 人 的 碰撞 事 

件 配 置 的 反馈 力矩 的 突变 阐 值 ; 

[L0111] ”车 有 反馈 力 盾 达到 反馈 力矩 突 变 阔 值 , 则 确定 发 生机 器 人 的 碰撞 事件 ,页 撞 事 件 用 

于 指示 机 器 人 发 生 碰 撞 。 

[0112] ”在 该 设置 下 , 知 监测 的 反馈 力矩 的 值 符 合 本 申请 提前 为 机 器 人 发 生 的 碰撞 情况 所 

配置 的 突变 范围 ,显然 ,可 认定 机 器 人 发 生 了 碰撞 ,并 生成 一 人 碰撞 事件 , 供 机 器 人 做 出 相应 

的 响应 处 理 , 以 减少 碰撞 带 来 的 损失 。 

L0113] ”举例 而 言 , 该 反馈 力矩 突变 阔 值 除了 可 以 为 固定 值 ,还 可 以 是 动态 值 ,具体 可 以 是 

跟随 机 器 人 的 动态 运动 状态 设置 的 ,如 此 达到 适 配 机 器 人 的 实时 状态 而 灵活 调整 的 效果 ， 

也 就 是 说 ,可 实现 更 为 精确 的 碰撞 检测 。 

L0114] ”作为 动态 的 反馈 力矩 突变 阐 值 的 一 种 具体 计算 方式 ,可 通过 以 下 计算 公式 计算 得 

到 : 

[0115]  b(1)=@Qv, +p,tanh(a)(l—tanh(gy”))+h, 

L0116] ”其 中 ,i 用 于 指示 关节 电机 所 属 关 节 的 关节 标识 ,v; 用 于 指示 运行 速度 ,a; 用 于 指示 

a ;用 于 指示 第 一 增益 ,8; 用 于 指示 第 二 增益 , 4, 分 别 用 于 指示 tanh 函 数 在 零 值 附 
近 的 突变 速度 以 及 形式 ,to ;用 于 指示 关节 的 基础 偏 置 值 ,用 于 容许 反馈 力矩 中 用 于 补偿 前 

馈 的 控制 误差 部 分 ,可 看 作 是 模型 误差 ,可 以 针对 机 器 人 做 多 组 运行 试验 ,确定 动态 六 值 的 

上 下 界 , 其 中 每 个 关节 根据 实际 情况 设 定 上 下 界 闵 值 用 于 碰撞 方向 判定 。 

L0117] ”除了 可 检测 是 否 发 生 了 碰撞 , 当 确 定 发 生 了 碰撞 后 ,还 可 对 本 次 碰撞 事件 进行 进 

一 步 的 细 化 分 析 ,判断 碰撞 特征 ,以 方便 根据 碰撞 特征 ,进行 适 配 的 控制 切换 。 

[0118] ”作为 一 种 具体 的 实现 方式 ,碰撞 事件 的 分 析 处 理 ,可 包括 : 

L0119] ”根据 反馈 力矩 的 力矩 特征 ,确定 碰撞 事件 的 磁 撞 类 型 ， 

L0120] ”根据 碰撞 类 型 ,确定 机 器 人 对 碰撞 事件 的 安全 响应 策略 

[0121] ”执行 安全 响应 策略 。 

[0122] ”可 以 理解 ,可 提取 反馈 力矩 的 力矩 特征 ,典型 的 可 以 根据 其 在 短 时 间 内 的 变化 特 

征 ,分析 其 所 处 磁 撞 事件 的 碰撞 类 型 ,如 此 可 根据 具体 的 碰撞 类 型 ,执行 不 同 的 安全 响应 策 

略 。 

[0123] ”在 实际 应 用 中 ,机 器 人 在 运动 过 程 中 由 于 运行 状态 、 磁 撞 物 体 特性 等 不 同 ,反映 出 

来 的 碰撞 特性 也 各 不 相同 。 

L0124] ”优选 地 ,将 磁 撞 事件 划分 为 以 下 几 种 : 

[0125] 与 刚性 物体 发 生 磁 撞 , 如 电气 设备 、 墙 体 等 ; 
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[0126] 
[0127] 
[0128] 
[0129] 
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与 柔性 物体 发 生 碰 撞 , 如 海绵 泡沫 .电线 人体 等 
试探 性 碰撞 ,如 人 工 有 意 或 无 意 地 进行 探测 性 碰撞 。 
具体 地 ,基于 采样 力矩 的 幅 值 和 频率 特性 对 机 器 人 进行 碰撞 特征 分 析 。 
碰撞 的 一 瞬间 可 认为 发 生 碰 撞 的 两 物体 在 接触 的 过 程 中 由 运行 速度 降 
程 , 即 两 者 将 碰撞 的 


会 已 旦 
用 里. 


生 磁 撞 的 物体 的 运动 状态 进行 区 分 : 


[0130] 


优选 地 ,对 前 


止 物体 


出 迅速 上 升 的 情 


在 与 其 接触 的 过 程 中 ,力矩 反馈 呈现 出 缓慢 上 升 的 情 
曾 长 速率 在 区 分 物体 特性 ; 
优选 地 ,在 前 


的 
[0131] 


至 况 ; 而 柔性 物体 由 于 在 压力 作用 下 会 


止 物 体 的 基础 上 分 析 运 动 型 物体 ,在 不 区 分 物体 特性 的 基 
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为 0 的 过 


反馈 到 反馈 控制 回路 中 ,在 进行 磁 撞 分 析 时 ,需要 根据 与 机 器 人 发 


进行 区 分 ,机 器 人 在 与 物体 进行 接触 时 会 由 于 物体 表面 的 物 
理 特性 而 发 生 不 同 的 力矩 反馈 。 刚 性 物体 由 于 在 压力 作用 下 不 易 形 变 ,在 力矩 反馈 中 
呈现 出 非 线性 弹 赞 的 特性 , 
请 况 , 因此 可 以 按照 碰撞 时 的 反馈 力矩 


呈现 
机 器 人 


础 之 上 , 进 


行 运动 方向 的 区 分 。 如 果 物 体 相 如 果 运 动物 体 与 机 器 人 运动 方向 相同 ,认定 碰撞 的 条 件 是 


物体 运动 速度 比 机 器 人 运动 速度 小 ,但 由 于 碰撞 时 刻 的 
撞 上 略 低 ; 当 运 动物 体 与 机 器 人 运动 相同 时 ,此 时 碰撞 时 刻 的 相对 速度 加 高 ,因此 
在 幅 值 上 要 比 物体 前 
因此 需要 使 用 

在 无 意识 碰撞 的 基 


物体 静止 辜 


[0132] 
[0133] 
以 上 讨论 


青 况 有 所 不 同 ,试探 性 碰撞 一 


止 碰撞 时 上 略 高 。 


础 上 ,优选 地 , 当 磁 撞 物 体 存 在 意识 的 


表 况 下 ,人 磁 撞 的 情况 就 与 


色 对 速度 较 小 ,所 以 在 幅 值 上 要 比 


般 存 在 时 间 短 、 冲 击 幅度 大 的 情况 ,由 于 试探 的 过 程 


中 需要 与 机 器 人 相向 运动 ,并且 一 般 速 度 要 相对 较 大 些 ,在 高 速 运动 中 ,为 简化 处 理 ,物体 


常 者 
T 


试探 性 碰撞 与 刚性 碰撞 的 区 分 点 。 


表面 特性 可 以 忽略 。 所 以 可 以 与 刚性 物体 相同 运动 的 情况 类 似 ,不 同 的 是 试探 性 碰撞 维持 


时 间 相 较 于 被 动 碰撞 的 时 间 短 很 多 ,通常 都 是 在 碰撞 后 就 直接 撤离 ,因此 可 以 将 时 间作 为 


[0134] ”假设 已 知 机 器 人 在 当前 反馈 力矩 对 应 运行 速度 v 下 测 得 的 刚性 增长 速度 n, 、 和 柔性 
增长 速度 n, ,以 及 维持 时 长 t,, 考 虑 到 运行 中 的 不 确定 因素 ,可 增加 偏 置 值 来 增加 静止 物体 
的 判定 范围 ,设置 增长 速度 正 向 偏 置 态 / 及 增长 速度 负 向 偏 置 7 

[0135] “如 此 ,后 续 在 得 到 机 器 人 的 当前 反馈 力矩 时 , 若 确定 对 应 运行 速度 为 v, 则 其 碰撞 
类 型 的 确定 可 通过 如 下 内 容 实 现 : 

[0136] ”确定 当前 反馈 力矩 的 维持 时 长 + 以 及 增长 速率 ni 

[0137] 。 车 7>7 .7 、t>t, ,确定 刚性 物体 碰撞 类 型 ， 

[0138] ”其 中 ,a) 车 7>Wr+ 吕 7 ,确定 碰撞 物体 与 机 器 人 相向 运动 ;b) 若 
< -Ww ,确定 碰撞 物体 与 机 器 人 同 向 运动 ;c) 车 7<Wr+ 呀 7 且 
ee eb i 
增益 以 及 刚性 增长 速度 负 向 增益 ; 

[0139] en te RN 

[0140] 其 中 ,a) 车 7>W/+ WW ,确定 碰撞 物体 与 机 器 人 相向 运行 ;b) 若 
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<7/ -Wi ,确定 碰撞 物体 与 机 器 人 同 向 运动 ;c) 车 <Wy4W 上 且 
>7,/_Wi 1, ,确定 碰撞 物体 为 静止 碰撞 物体 ,WW 以 及 分别 为 预 设 的 柔性 增长 速度 正 
向 增益 以 及 柔性 增长 速度 负 辐 增益 。 

[0141] “ 若 未 确定 刚性 物体 碰撞 类 型 ,也 未 确定 柔性 物体 碰撞 类 型 , 则 确定 试探 性 物体 碰 
撞 类 型 。 

[0142] “上述 作 为 判定 依据 的 n, 有 具体 可 通 人 同时 ， 
对 于 风 、WW、 W/W 这 类 增益 参数 ， A 过 前 期 试验 设置 的 ,mn 
还 可 与 n, rtn, + 相 接 ,以 尽量 覆盖 所 有 判断 区 域 。 

[0143] ”此 外 ,对 于 上 述 提 及 的 n， ,ny + 以 及 t,, 是 可 以 预先 根据 机 器 人 的 实际 情况 设置 
的 , 即 , 在 机 器 人 在 当前 反馈 力矩 对 应 运行 速 束 度 v 下 测 得 ,或 者 ,人 工 根据 机 器 人 在 当前 反馈 
力矩 对 应 运行 速度 v 下 的 工作 状态 下 设置 。 

[0144] ”进一步 的 ,nn p 以 及 t,, 还 可 以 为 实时 确定 的 参数 ,以 更 灵活 的 方式 贴近 于 实 
际 情况 ,从 而 达到 更 为 精确 的 碰撞 类 型 的 判断 效果 。 

[0145] 示例 性 的 ,碰撞 瞬间 可 以 认为 机 器 人 的 当前 状态 未 发 生变 化 ,可 根据 机 器 人 的 当 
前 工作 状态 确定 n,n 以 及 t,, 如 ,可 根据 机 器 人 的 当前 运行 速度 或 者 加 速度 等 当前 工作 
状态 的 一 种 或 者 多 种 具体 参数 ,确定 n\n, 以 及 t,, 作 为 刚性 、 邓 性、 试探 性 物体 碰撞 类 型 
的 临界 状态 判定 依据 ， 本 申请 考虑 到 而 挤 能 时 量 和 维持 时 间 分 别 与 运行 速度 和 加 速度 ,呈正 
相关 和 负 相 关 的 关系 ,因此 ,可 通过 组 合 、 变 形 等 形式 对 运行 速度 `. 加 速度 等 动态 的 当前 工 
作 状 态 具 体 参 数 ,设置 对 应 数据 处 理 策 略 ,以 贴 合 实际 情况 ,提高 判定 精度 ,具体 可 随 实际 
需要 调整 ,在 此 不 再 展开 袭 述 。 

[0146] ”通过 设 定 有 具体 的 判定 依据 对 碰撞 特征 进行 区 别 ,作为 后 续 安 全 响应 策略 的 实施 来 
[0147] ”在 安全 响应 策略 中 ,本 申请 根据 实际 情况 ,具体 可 配置 以 下 几 种 类 型 的 控制 方式 : 
[0148] ”1. 直 接 停止 

[0149] ” 当 机 器 人 发 生 人 碰撞 后 ,为 避免 对 碰撞 双方 造成 进一步 的 伤害 ,最 为 直接 也 是 简单 
的 方式 就 是 在 碰撞 检测 发 生 的 瞬间 ,直接 停止 机 器 人 的 运动 ,同时 将 各 关节 锁 死 。 

[0150] ”2. 回 退 N 帧 或 者 回 到 指定 安全 位 姿 

[0151] 回 退 N 帧 即 按照 机 器 人 运动 轨迹 的 反方 向 运动 , 因 机 器 人 在 发 生 碰 撞 前 的 历史 运 
行 轨 迹 是 相对 安全 的 ,可 以 按照 倒序 的 方式 向 机 器 人 发 送 历史 指令 值 。 与 之 思想 相同 的 是 
在 机 器 人 运动 范围 中 指定 一 个 安全 位 置 , 当 发 生 碰撞 时 , 令 机 器 人 直接 返回 指定 的 保证 安 
全 的 机 器 人 位 姿 。 

[0152] 3. 比例 缩减 运行 

[0153] ”在 机 器 人 运动 过 程 中 ,可 ei ,这 种 情况 只 需要 按 比例 缩 
小 机 器 人 的 运动 趋势 , 当 进入 试探 性 的 碰撞 检测 后 还 是 能 够 检测 到 碰撞 的 话 ,可 以 根据 后 
续 碰 撞 特 征 进入 下 一 状态 。 
[0154] 4. 零 力 控 制 /柔顺 控 促 
[0155] ”该 控制 形式 一 般 发 生 在 人 机 协作 情境 下 。 由 于 工作 人 员 的 主观 能 动 性 ,可 以 对 机 
器 人 做 避 障 引导 。 另 外 ,人 工 引 导 避 障 也 能 够 避免 未 知 的 后 续 伤 害 , 有 利于 保护 机 器 人 本 


sk 


一 


i 
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否 需 要 在 排除 碰撞 因素 后 是 否 进行 位 置 回复 来 选择 柔顺 


控 仲 
[0156] 
况 , 为 尽 可 色 


1 和 零 力 控制 。 
上 述 采 取 的 几 种 应 对 方式 ,如 果实 施 单个 策略 只 能 够 履 新 到 部 分 的 机 器 人 运动 情 
E 获 善 到 机 器 人 运动 情 


Ne 


适 配 的 具体 的 安全 响 


[0157] 
[0158] 


若 胡 
若 胡 


衣 况 ,本 申请 具体 还 可 针对 上 述 提 及 的 不 同 磁 撞 类 型 ,配置 


应 策略 内 容 : 


站 撞 类 型 


为 同 癌 运动 , 则 确定 比例 缩减 运动 趋势 的 安全 响应 策略 。; 


业 撞 类 


型 为 相向 运动 且 为 刚性 物体 碰撞 类 型 , 则 确定 


回 退 N 帧 运行 轨迹 或 者 返 


回 指定 安全 位 姿 的 安全 响应 集 略 ; 


[0159] ”和 若 而 


[0160] ”和 若 而 


东 撞 类 型 为 前 


虹 撞 类 型 为 相向 运动 且 为 柔性 物体 碰撞 类 型 , 则 确定 夫 
安全 响应 策略 ; 
止 桔 撞 物体 且 为 刚性 物体 磁 撞 类 型 , 则 和 


空 制 或 者 柔顺 控 伟 


| 的 


角 定 回 退 N 帧 运行 轨迹 或 


| 


者 返回 指定 安全 位 姿 的 安全 嘿 


[0161] 
零 力 挖 表 
[0162] 。 若 奏 


若 仙 


Ws 


或 者 柔顺 控 什 


闪 撞 类 型 为 削 


止 碰撞 物体 且 为 柔性 物体 人 


应 策略 ; 


让 


闻 撞 类 型 且 处 于 人 机 协作 环境 , 则 确 


下 撞 类 型 为 前 


定 回 退 N 帧 运 
[0163] 


行 轨迹 或 者 返 


| 的 安全 响应 策略 ; 
止 碰撞 物体 且 为 柔性 物体 硼 


闪 撞 类 型 昌 未 处 于 人 机 协作 环境 , 则 确 
应 策略 。 


| 


回 指定 安全 位 姿 的 安全 响 


具体 的 ,在 同 向 运动 中 ,不 考虑 物体 特性 ,由 


于 物体 运行 速度 相对 于 机 器 人 过 慢 导 


致 的 碰撞 。 在 降低 损伤 和 不 影响 机 器 人 运行 轨迹 的 考虑 ,可 以 将 机 器 人 运行 速度 放 绥 , 即 比 
例 缩减 运行 方式 ; 


[0164] 


具体 地 ,在 相向 运动 中 ,在 工作 场景 
外 腕 来 保护 内 部 ,而 运动 的 柔性 材质 的 物体 可 认 


可 进行 运动 的 设备 一 般 都 具有 刚性 材质 的 
为 人 体 , 因 此 在 进行 相向 运动 的 情况 下 ， 


7 


作 


如 刚性 碰撞 ,可 采取 回 退 N 帧 或 回 到 安全 位 置 的 方法 来 避免 与 相向 运动 物体 进行 再 次 碰撞 ; 


如 柔性 碰撞 , 则 认定 为 与 人 体 本 身 发 生 碰 撞 , 则 可 采用 零 力 控 表 


人 为 避 障 ; 
[0165] 


具体 地 ? 在 司 


1 或 柔顺 控 


制 的 方式 来 进行 


止 物 体 发 生 碰 撞 时 ,由 于 物体 本 身 的 位 置 不 会 发 生变 化 ,如 果 是 刚性 


物体 ,为 避免 进一步 损伤 ,可 按照 回 退 N 帧 或 返回 安全 位 置 法 ;柔性 物体 需要 考虑 到 是 否 存 


在 人 机 协作 场 


[0166] 


[0167] 


,为 进一步 的 


复杂 情 


策略 状态 转移 处 理 的 具体 内 容 , 


的 一 种 场景 示意 图 
其 中 ,值得 一 


[0168] 


行 柔 顺 控 种 


小 零 力 控 促 
试探 性 磁 撞 后 并 不 影响 当前 控 表 


景 ,如 存在 ,可 假设 柔性 物体 为 人 体 ,此 时 则 需要 按照 零 力 控 和 
方法 ;如 不 存在 , 则 可 按照 刚性 物体 进行 设 
此 外 
响应 内 容 的 基 
中 发 生 如 再 次 碰撞 等 


上 或 柔顺 控制 的 


Oz 


人 。 


对 碰撞 事件 实现 更 为 灵活 、 有 效 的 安全 响应 ,本 申请 还 可 在 上 述 


础 上 ,增加 了 安全 响应 策略 的 策略 状态 转移 处 理 , 以 应 对 在 处 理 碰撞 的 过 程 


衣 训 。 


具体 可 参考 图 3 示 出 的 本 申请 策略 状态 转移 处 理 


,具体 在 此 不 再 详细 展开 。 
提 的 是 ,如 在 机 器 人 运行 阶段 ,如 果 发 生 和 柔性 碰撞 后 ,可 根据 设 定 j 
| 模式 由 人 工 做 进一步 处 理 ,如果 在 处 理 过 程 中 再 次 遇 到 柔性 碰撞 或 


| 模式 的 运行 ,但 在 遇 到 刚性 碰撞 或 后 , 则 在 实际 应 用 中 ,可 


采取 立即 停止 作为 最 优 的 
以 上 是 本 申请 
I 方法 ,本 申请 还 


[0169] 


器 人 的 控 币 


提 人 ~ 


相应 方式 。 
机 器 人 的 控 上 
:提供 


| 方法 的 介绍 ,为 便于 更 好 的 实施 本 申请 


了 机 器 人 的 控制 装置 。 
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[0170] ”参阅 图 4, 图 4 为 本 申请 机 器 人 的 控制 装置 的 一 种 结构 示意 图 ,在 本 申请 中 ,机 器 人 
的 控制 装置 400 具 体 可 包括 如 下 结构 : 

[0171] ”采集 单元 401, 用 于 当 受 控 的 机 器 人 处 于 工作 状态 时 ,采集 机 器 人 的 状态 数据 ; 
L0172] 输入 单元 402, 用 于 将 状态 数据 输入 预先 为 机 器 人 训练 好 的 动力 学 模型 ,得 到 机 器 
人 的 关节 电机 的 前 馈 力 矩 ， 

[0173] ”提取 单元 403 ,用 于 提取 关节 电机 所 处 反馈 回路 设置 的 反馈 控制 器 输出 的 反馈 力 
和 矩 ; 

[0174] ”生成 单元 404, 用 于 在 反馈 力矩 作为 补偿 控制 源 的 基础 上 ,根据 前 馈 力矩 生成 控 和 
力矩 ， 
[0175] ”控制 单元 405, 用 于 以 控制 力矩 控制 关节 电机 的 工作 。 

L0176] 在 又 一 种 示例 性 的 实现 方式 中 ,动力 学 模型 具体 为 神经 网 络 模型 ,神经 网 络 模型 
是 通过 标注 有 对 应 前 馈 力矩 的 不 同 状 态 数 据 训 练 得 到 的 。 

L0177] 在 义 一 种 示例 性 的 实现 方式 中 ,装置 还 包括 判断 单元 406, 用 于 : 

[0178] ”将 反馈 力矩 与 反馈 力矩 突变 病 值 进行 比 对 ,反馈 力矩 突变 闷 值 为 机 器 人 的 碰撞 事 
件 配置 的 反馈 力矩 的 突变 阔 值 ; 

[0179] 若 反 馈 力矩 达到 反馈 力矩 突变 病 值 , 则 确定 发 生机 器 人 的 碰撞 事件 , 碰 接 事件 用 
于 指示 机 器 人 发 生 碰 撞 。 

[0180] ”结合 本 申请 第 二 方面 第 二 种 可 能 的 实现 方式 ,在 本 申请 第 二 方面 第 三 种 可 能 的 实 
现 方 式 中 ,反馈 力矩 突变 闵 值 是 跟随 机 器 人 的 动态 运动 状态 设置 的 ,反馈 力矩 突变 闵 值 通 
过 以 下 计算 公式 计算 得 到 : 

[0181] bb(f)=Qw,+p, tanh(a)(l—tanh(Gy” )) +t,; 

L0182] ”其 中 ,ji 用 于 指示 关节 电机 所 属 关 贡 的 关节 标识 ,vi 用 于 指示 运行 速度 ,ai 用 于 指示 
加 速度 ,a; 用 于 指示 第 一 增益 ,B; 用 于 指示 第 二 增益 , $i 、n ;分别 用 于 指示 tanh 函 数 在 零 值 附 
近 的 突变 速度 以 及 形式 ,tu ;用 于 指示 关节 的 基础 偏 置 值 。 

L0183] ”在 义 一 种 示例 性 的 实现 方式 中 ,装置 还 包括 响应 单元 407, 用 于 : 

L0184] ”根据 反馈 力 抢 的 力矩 特征 ,确定 碰撞 事件 的 碰撞 类 型 

[0185] ”根据 碰撞 类 型 ,确定 机 器 人 对 碰撞 事件 的 安全 响应 策略 ; 

[0186] ”执行 安全 响应 策略 。 

[0187] ”在 又 一 种 示例 性 的 实现 方式 中 ,响应 单元 407, 具体 用 于 : 

[0188] ”确定 反馈 力矩 的 维持 时 长 t 以 及 增长 速率 n; 

[0189] ”车 7>77r -7 、t>t, ,确定 刚性 物体 碰撞 类 型 ,n， ,以 及 t, 分 别 为 机 器 人 在 反馈 力 
和 矩 对 应 当前 速度 v 下 测 得 的 刚性 增长 速度 以 及 维持 时 长 , 7 为 预 设 的 增长 速度 负 向 偏 置 ; 
[0190] ”其 中 , 若 7>7wr 寺 WW 77w ,确定 碰撞 物体 与 机 器 人 相向 运动 ;车 7<7r_W 7 , 确 
定 碰撞 物体 与 机 器 人 同 向 运动 ; 若 7 < 于 WW Vwi 且 7>7wr_W 7 ,确定 碰撞 物体 为 静止 
碰撞 物体 ,Ww; 以 及 WW 分 别 为 预 设 的 刚性 增长 速度 正 向 增益 以 及 刚性 增长 速度 负 向 增 


[0191] ”车 <7/ + ,确定 柔性 物体 碰撞 类 型 ,n， ,为 机 器 人 在 反馈 力矩 对 应 当前 速度 v 
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下 测 得 的 柔性 增长 速度 , /为 预 设 的 增长 速度 正 向 偏 置 ，; 

[0192] ”其 中 , 若 7> wy 十 WL , 人 确定 碰撞 物体 与 机 器 人 相同 运行 ;车 < -Wy , 确 
定 碰撞 物体 与 机 器 人 同 向 运动 ;车 7 二 W 办。 且 7> ov- Ww 17 ,确定 碰撞 物体 为 静止 
碰撞 物体 ,wi 以 及 Wr 分 别 为 预 设 的 柔性 增长 速度 正 向 增益 以 及 柔性 增长 速度 负 向 增益 ; 
[0193]  ” 若 未 确定 刚性 物体 碰撞 类 型 ,也 未 确定 柔性 物体 碰撞 类 型 , 则 确定 试探 性 物体 碰 
撞 类 型 。 

[0194] ”在 又 一 种 示例 性 的 实现 方式 中 ,响应 单元 ,具体 用 于 : 

[0195] ”车 碰撞 类 型 为 同 辐 运动 , 则 确定 比例 缩减 运动 趋势 的 安全 响应 集 略 ; 

[0196] ”车 碰 撞 类 型 为 相同 运动 且 为 刚性 物体 碰撞 类 型 , 则 确定 回 退 N 帧 运行 轨迹 或 者 返 
回 指定 安全 位 姿 的 安全 响应 策略 ; 

[0197] ”知人 磁 撞 类 型 为 相同 运动 且 为 柔性 物体 碰撞 类 型 , 则 确定 零 力 控制 或 者 柔顺 控制 的 
安全 响应 策略 ; 
[0198] “知人 磁 撞 类 型 为 静止 碰撞 物体 且 为 刚性 物体 碰撞 类 型 , 则 确定 回 退 N 帧 运行 轨迹 或 
者 返回 指定 安全 位 姿 的 安全 响应 策略 ; 

[0199] “” 知 倍 撞 类 型 为 静止 碰撞 物体 且 为 柔性 物体 碰撞 类 型 且 处 于 人 机 协作 环境 , 则 确定 
零 力 控制 或 者 柔顺 控制 的 安全 响应 策略 ; 
[0200] “” 知 磁 撞 类 型 为 静止 碰撞 物体 且 为 柔性 物体 碰撞 类 型 且 未 处 于 人 机 协作 环境 , 则 确 
定 回 退 N 帧 运行 轨迹 或 者 返回 指定 安全 位 姿 的 安全 响应 策略 。 
[0201] “本 申请 还 提供 了 机 器 人 的 控制 设备 ,参阅 图 5 ,图 5 示 出 了 本 申请 机 器 人 的 控制 设 
备 的 一 种 结构 示意 图 ,具体 的 ,本 申请 机 器 人 的 控制 设备 可 包括 处 理 器 501、 存 储 器 502 以 及 
输入 输出 设备 503, 处 理 器 501 用 于 执行 存储 器 502 中 存储 的 计算 机 程序 时 实现 如 图 1 对 应 实 
施 例 中 机 器 人 的 控制 方法 的 各 步骤 ;或 者 ,处 理 器 501 用 于 执行 存储 器 502 中 存储 的 计算 机 
程序 时 实现 如 图 4 对 应 实施 例 中 各 单元 的 功能 ,存储 器 502 用 于 存储 处 理 器 501 执 行 上 述 图 1 
对 应 实施 例 中 机 器 人 的 控制 方法 所 需 的 计算 机 程序 。 

[0202] ”示例 性 的 ,计算 机 程序 可 以 被 分 割 成 一 个 或 多 个 模块 /单元 ,一 个 或 者 多 个 模块 / 
单元 被 存储 在 存储 器 502 中 ,并 由 处 理 器 501 执 行 , 以 完成 本 申请 。 一 个 或 多 个 模块 /单元 可 
以 是 能 够 完成 特定 功能 的 一 系列 计算 机 程序 指令 段 , 该 指令 段 用 于 描述 计算 机 程序 在 计算 
机 装置 中 的 执行 过 程 。 

[0203] ”机 器 人 的 控制 设备 可 包括 ,但 不 仅 限 于 处 理 器 501、 存 储 器 502、 输 入 输出 设备 503。 
本 领域 技术 人 员 可 以 理解 ,示意 仅仅 是 机 器 人 的 控制 设备 的 示例 ,并 不 构成 对 机 器 人 的 控 
制 设 备 的 限定 ,可 以 包括 比 图 示 更 多 或 更 少 的 部 件 ,或 者 组 合 某 些 部 件 ,或 者 不 同 的 部 件 ， 
例如 机 器 人 的 控制 设备 还 可 以 包括 网 络 接 入 设备 、 总 线 等 ,处 理 器 501、 存 储 器 502、 输 入 输 
出 设备 503 以 及 网 络 接 入 设备 等 通过 总 线 相连 。 
[0204] 处理 器 501 可 以 是 中 央 处 理 单元 (Central Processing Unit,CPU) ,还 可 以 是 其 他 
通用 处 理 器 、 数 字 信 号 处 理 器 (Digital Signal Processor,DSP) 专用 集成 电路 
(Application Specific Integrated Circuit,ASIC) 、 现 成 可 编程 门 阵列 (Field- 
Programmable Gate Array,FPGA) 或 者 其 他 可 编程 逻辑 器 件 、 分 立 门 或 者 晶体 管 逻 辑 器 件 、 
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分 立 硬件 组 件 等 ,通用 处 理 器 可 以 是 微 处 理 器 或 者 该 处 理 器 也 可 以 是 任何 常规 的 处 理 器 
等 ,处 理 器 是 机 器 人 的 控制 设备 的 控制 中 心 ,利用 各 种 接口 和 线路 连接 整个 设备 的 各 个 部 
分 。 

[0205] ”存储 器 502 可 用 于 存储 计算 机 程序 和 /或 模块 ,处 理 器 501 通 过 运行 或 执行 存储 在 
存储 器 502 内 的 计算 机 程序 和 /或 模块 ,以 及 调用 存储 在 存储 器 502 内 的 数据 ,实现 计算 机 装 
置 的 各 种 功能 ,存储 器 502 可 主要 包括 存储 程序 区 和 存储 数据 区 ,其 中 ,存储 程序 区 可 存储 
操作 系统 、 至 少 一 个 功能 所 需 的 应 用 程序 等 ;存储 数据 区 可 存储 根据 机 器 人 的 控制 设备 的 
使 用 所 创建 的 数据 等 。 此 外 ,存储 器 可 以 包括 高 速 随机 存 取 存储 器 ,还 可 以 包括 非 易 失 性 存 
储 器 ,例如 硬盘 内存 、 插 接 式 硬 盘 , 智能 存储 卡 (Smart Media Card,SMC) ,安全 数字 
(Secure Digital,SD) 卡 ,闪存 卡 (Flash Card) 至少 一 个 磁盘 存储 器 件 、 闪存 器 件 、 或 其 他 
易 失 性 固态 存储 器 件 。 

[0206] ”处理 器 501 用 于 执行 存储 器 502 中 存储 的 计算 机 程序 时 ,具体 可 实现 以 下 功能 : 
L0207] “” 当 受 控 的 机 器 人 处 于 工作 状态 时 ,采集 机 器 人 的 状态 数据 ; 

[0208] ”将 状态 数据 输入 预先 为 机 器 人 训练 好 的 动力 学 模型 ,得 到 机 器 人 的 关节 电机 的 前 
馈 力 矩 ; 

[0209] ”提取 关节 电机 所 处 反馈 回路 设置 的 反馈 控制 器 输出 的 反馈 力矩; 

[0210] ”在 反馈 力矩 作为 补偿 控制 源 的 基础 上 ,根据 前 馈 力 矩 生 成 控制 力矩 ,并 以 控制 力 
矩 控 制 关 节 电 机 的 工作 。 
[0211] ”所 属 领 域 的 技术 人 员 可 以 清楚 地 了 解 到 ,为 描述 的 方便 和 简洁 ,上述 描 述 的 机 器 
人 的 控制 装置 .设备 及 其 相应 单元 的 具体 工作 过 程 , 可 以 参考 如 图 1 对 应 实施 例 中 机 器 人 的 
控制 方法 的 说 明 ,具体 在 此 不 再 更 述 。 

[0212] ”本 领域 普通 技术 人 员 可 以 理解 ,上 述 实施 例 的 各 种 方法 中 的 全 部 或 部 分 步骤 可 以 
通过 指令 来 完成 ,或 通过 指令 控制 相关 的 硬件 来 完成 ,该 指令 可 以 存储 于 一 计算 机 可 读 存 
储 介质 中 ,并 由 人 处理 器 进行 加 载 和 执行 。 


L0213] ”为 此 ,本 申请 提供 一 种 计算 机 可 读 存 储 介质 ,其 中 存储 有 多 条 指令 ,该 指令 能 够 被 
处 理 器 进行 加 载 ,以 执行 本 申请 如 图 1 对 应 实施 例 中 机 器 人 的 控制 方法 中 的 步骤 ,具体 操作 


可 参考 如 网 1 对 应 实施 例 中 机 器 人 的 控制 方法 的 说 明 ,在 此 不 再 更 述 。 

[0214] ”其 中 ,该 计算 机 可 读 存 储 介 质 可 以 包括 :只 读 存 储 器 (Read 0nly Memory ,ROM 、 随 
机 存 取 记忆 体 (Random Access Memory,RAM 、 磁 盘 或 光盘 等 。 

[0215] ”由 于 该 计算 机 可 读 存 储 介质 中 所 存储 的 指令 ,可 以 执行 本 申请 如 图 1 对 应 实施 例 
中 机 器 人 的 控制 方法 中 的 步骤 ,因此 ,可 以 实现 本 申请 如 图 1 对 应 实施 例 中 机 器 人 的 控制 方 
法 所 能 实现 的 有 益 效 果 , 详 见 前 面 的 说 明 ,在 此 不 再 更 述 。 

[0216] ”以 上 对 本 申请 提供 的 机 器 人 的 控制 方法 、 装 置 、 设 备 以 及 计算 机 可 读 存 储 介 质 进 
行 了 详细 介绍 ,本 文中 应 用 了 具体 个 例 对 本 申请 的 原理 及 实施 方式 进行 了 阅 述 ,以 上 实施 
例 的 说 明 只 是 用 于 帮助 理解 本 申请 的 方法 及 其 核心 思想 ;同时 ,对 于 本 领域 的 技术 人 员 , 依 
据 本 申请 的 思想 ,在 具体 实施 方式 及 应 用 范围 上 均 会 有 改变 之 处 , 综 上 所 述 , 本 说 明 书 内 容 
不 应 理解 为 对 本 申请 的 限制 。 
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当 受 控 的 机 器 人 处 于 工作 状态 
时 ， 采 集 机 器 人 的 状态 数据 


将 状态 数据 输入 预先 为 机 器 人 
训练 好 的 动力 学 模型 ， 得 到 机 
器 人 的 关节 电机 的 前 馈 力 给 


提取 关节 电机 所 处 反馈 回路 设 
置 的 反馈 控制 器 输出 的 反馈 力 
天 


在 反馈 力矩 作为 补偿 控制 源 的 

基础 上 ， 根 据 前 馈 力 答 生成 控 

制 力矩 ， 并 以 控制 力矩 控制 关 
节 电 机 的 工作 


图 2 
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一 段 时 间 内 没有 础 撞 出 现 


刚性 磁 撞 刚性 /柔性 碰撞 


a 回 退 N 帧 或 回 
比例 缩减 运行 到 安全 位 置 ore ) 
柔性 静止 \ 相 向 碰撞 试探 性 碰撞 zz 


试探 性 / 同 向 碰撞 
刚性 静止 \ 相 向 碰撞 


图 3 
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机 器 人 的 控制 设备 
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